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*088t£fS(Pb2_s, e K sJSjJWFT-S,, 
Pb2_s = Pb + (Pb2_p-Pbj> 

eb2_*= 9b + ieb2j>-gb_p) 
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(Pb2_s, © b2_sli52 E ffiS&<£>S*f§(Pb2_ S + A Phx, 9 b2_sk (Pb2_s+ A Pbi, 9 b?_s). 
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S200 ... BASED ON INSTANTANEOUS VALUE OF SIMPLIFIED MODEL GAIT 
AT PRESENT TIME t , DETERMINE EACH MASS POINT UPPER BODY 
POSITION AND POSTURE OF FIRST DISPLACEMENT DIMENSION 
CORRECTING MODEL. 

S202... BASED ON DISPLACEMENT DIMENSION CORRECTED UPPER 

BODY POSITION Pb2 _p AT PREVIOUS TIME t — At TARGET UPPER BODY 
POSITION pb_p, DISPLACEMENT DIMENSION CORRECTED UPPER BODY 
POSTURE 6 2b_p, TARGET UPPER BODY POSTURE #b_K TARGET 
UPPER BODY POSITION Pb AT PRESENT TIME t , AND TARGET UPPER 
BODY POSTURE 6b, DETERMINE INITIAL CANDIDATES (Pb2_S, 6 b2_s) 
OF DISPLACEMENT DIMENSION CORRECTED UPPER BODY POSITION 
AND POSTURE USING FOLLOWING EXPRESSIONS. 
Pb2 s = Pb + (Pb2_p-Pbj> 
0l?_s= 9b + (eb2_p-0b_p> 

S206- BASED ON CURRENT CANDIDATE (Pb2_s, 0b2ji) AND TARGET 
BOTH FEET-POSITIONS AND POSTURES AT PRESENT TIME t ; 
DETERMINE POSITION OF EACH MASS POINT FOR SECOND 
DISPLACEMENT DIMENSION CORRECTING MODEL 
S208 - DETERMINE DECLINATION Gc_mt OF OVERALL BARYCENTER 
AND DECLINATION L_err OF ANGULAR MOMENTUM PRODUCT 
BETWEEN FIRST DISPLACEMENT DIMENSION CORRECTING MODEL 
AND SECOND DISPLACEMENT DIMENSION CORRECTING MODEL. 



S210 - AND L_err ARE WITHIN ALLOWABLE RANGE? 

S212-. EXIT FROM REPEAT LOOP. 

S214... SET CANDIDATES (Pb2_s+ A Pbx, 8 b2_s), (Pt2_j+ A Pin, 8 b2_s). 

(Pb2_s, 9b2_s + A 6b) IN VICINITY OF (Ph2_s, 9h2_s| . AND BY USING 
THEM AS DISPLACEMENT DIMENSION CORRECTED UPPER BODY 
POSITION AND POSTURE CANDIDATES, DETERMINE DECLINATION OF 
OVERALL BARYCENTER AND DECLINATION OF ANGULAR MOMENTUM 
PRODUCT AS DESCRIBED ABOVE 

S216 ... BASED ON DECLINATION OF OVERALL BARYCENTER AND 

DECLINATION OF ANGULAR MOMENTUM PRODUCT CORRESPONDING 
TO (Pb2_s, 9b2_s) AND EACH CANDIDATE IN VICINITY OF THIS. 
DETERMINE NEW CANDIDATE (H>2_S, 9 b2_s) OF DISPLACEMENT 
DIMENSION CORRECTED UPPER BODY POSITION AND POSTURE SO 
THAT THE DECLINATIONS APPROACH 0. 

S218... SUBSTITUTE THE CURRENT (Pb2j 6 Vljl TO DISPLACEMENT 
DIMENSION CORRECTED UPPER BODY POSITION AND POSTURE 
(Pb2,9b2) AT PRESENT TIME 1 . 



(57) Abstract: An instantaneous 
target motion of a robot (1) is 
created by using a dynamic model. 
From the instantaneous target 
motion, a first arrangement of 
the model elements (such as a 
link having a mass point and an 
inertia) of a model expressing 
the robot (1) is determined under 
a first geometrical constraint 
condition. The instantaneous target 
motion is corrected. From this 
corrected target motion, a second 
arrangement of the model elements 
is determined under a second 
geometrical constraint condition. 
The corrected target motion is 
determined is determined so that 
the moment components calculated 
from the difference between the 
first and second arrangements 
approaches a predetermined value. 
The instantaneous target motion 
is created by using the robot 
dynamic model. Thus, the robot 
instantaneous target gait motion 
created by using the dynamic 
model is adequately corrected 
without using a dynamic model, 
and the dynamic accuracy of the 
instantaneous target gait including 
the corrected motion is enhanced. 
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[0061] Jiflc&Bfct, ±m(D^h^^^t^mM±i^3KM\^X^MKm^m^ 
^22(Dhht^^^tz.i^mM^^22KMVX^MKm^m^tcvi— J3)V 

mm±(x^Mi^ma^mi^2(D^mn(D^>t^h^^22(Dmm^(Dmm 
$mmmb$it>z>&m i-mmztiZo 
[0062] ±mizmirZ)MmffijE g m±i^mm^xfmiE g m±^mm^ &s>m*bte 
% g m±w-mm m g ^_h#;^#) *3«tt^ g m±m±m m g tsi±fwag) £*&:e 
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[oo63] zimmm-^fe. mM&^z&^ti&t&^m&iaz. ufu* r nmi&s 
[oo64] £fag©5*><z\ K&t>zm&m#&.fit4>mtim#. w*>ji¥ti^ 

)&r#J£5p^^jj£iq^ n^yM(D^T(2o)(DM 5 P22R, 22LlCoV^T<Dr# 
[0065] @^y*£tijte, — jRtofcira:, ftm&b*<Dj&tzftmTZ&Mfi&Tfi*~*ishb\z. 

iittfi (z«) Sr&i >To^*s„ tewrtitt. a f^fr 

[0066] »^ift¥^#£«M-r5^-ete, p^Mo s @»b#at£>£>#m 

[0067] P#VM(Z)rff^l^iat W^.tf*WJKA^i21#M¥lO-8608 

&<D&m\u:zw^bmfib<D&fi&BmzMPizt>mz&&rz>*e-- 
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[0068] — ^ j^SiJ^o^L<fi«^o^^^5^H#W^#5^-e^ti^Vhi(D#»], 

o 

[0069] ^.(DXyf^t^h, ^mmm^mmmmx^ m^^mmioo^mtiir^nm 
[0070] ^lt, ^w#m#-e«, mm^mmmoo^mtiir^ nm&mii, ixm^n, n 

[0071] ^mmw<Dmm^mK^ ^x^ g mmm (^m^mmmioo^ 
m^-rs g m&m ^mi-^x^mnxi^i-^ g »^ m g -era, 

temzotztiZo tot, ^n-w^^i-^g^^^^g^^c^^o^ 

^^f/««*5ciEM) -Ctt, _hfE$fe$S<D g HIM^, «jE g H 
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st^rs^wjam-c^-rs g g a^asw ^g^mis-r^ 

g «H g fJlJ^H^-^h^l&v yfcfctf) ( g mzMP&ffi&tt&m) 

[0072] ^*d\ sk&fDmm-zte. ttRAmwj&fti&r^mR*mwj&&i^tic'rz 

[0073] BS^©ri^jtt. n/^VMO^(DiW#:2^jfib-Cd^5— ^©JW 

[0074] ^gfc^ttSPffW^^fcri, p^M^^o ifi2rMP#:2, 2-C^-f 

P^«^^V^Tn#Vhl^gfi^^L^VMl"J^)P#:2^3SPi:^ 0 >t 
[0075] g «^©*Lattt, ^ti-/VVJii^ (*l!l@S$tbfeJffitSI3R) -ClB^^tb 

M¥22^^Lfc^(D^M¥22^tu^^fRl^Xtt^fB] N ^^'fB]^Y#^fB]^ 
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[0077] m^<Dta<, &&&j$mmioot3&&s*9*— #®:mmooa&mx.z>o mm^9 

[0079] ^^aeeioods n m&&&&fci'z>k^ mm^22(Dmm^m^ 

[0080] #wffl*©2iJfe7gtrett, ^sasiooa^^^i- £#3^9 

[0081] rr-e, MfB3ap_hfl^!&«Lj!tt, ft^^#^^3ieioo^t±i^;i-^cD-e 

[0082] *fc, ffrlBZMPi^tBffl^lMLTM^i-^^, *p^*H#^^W^-e^, 
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[0083] ifiE^fc^ (^^smooasftifcBifcffl^-rs a ©K©zmp 

<Dmtt%X&ft%\J& ^b{RfeUtittte&tfZfcBU]*'bJ& (ZMP) <D#^ *J 

^jE$tbfc#^(D*<DZMP{*, ZMP#^Br|g$5ffl(D^^(Dcp'^#jfi^>^ffl^fe 

#^-e#§fF^H^^i-a„ ^o^H^ZMPfF^fSH^^o ZMPf^fSH 
E\ ZMP#^Brtgf5H^— &3VMiZMP#^fg$5Hft^^-£ 

[0084] &:Jb\ tt)fEbf-i5 IE, g ^ZMP^f9(DME g ^J^S^^-^^h^r g W^Rtl 
§&W.)$ft^$iWl'fchCD&, g ^ZMP^^J-r^^OZMP^^gcD-f^M^i" 
(D-C, g|^ZMP^«9(DMng^SiJ ; e-^h^fei-S'ft^«9^, PtlZMP 
^*rt-5K0ZMP<D^e<Di*^S(MH g tli*H^^-^vh^ZMP^»ftt) & 

SrfflWC, MEg^K^^-^h<^f^fBffl^^i-^i:^"Ct, MiEl 
[0085] HtflB^S^J^KTO^fF^IS}*, n^Vhl(DM^22(DJ^^(D^B^ N J£ 

<5o 

[0086] ^^^-^^$|3100a^^$^»^^^-^^ g^»#te^^§|5100 

2p_h^#, nm^m^mmm, gmzMP, nmmRm^m^m, nm^<D 
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[0087] g mmmmm&moob-ewMtstitc g anw^Hncr*, fMj^f>^^4^^i 

%<dx\ nm±.w-\imM^mmmi. smmmic^xmtkir&m^tv^yh 
i ici^m -rzmti t<D^-±s & g izmp^^9 ici^^-^^tm^o 

[oo88] nm±mzmmmz^t?nm^(unm^m<vmmmmikik 
m$tix\^<z.tkfj:z> 0 mmit^T^^^mmoocxMhfLfcnm± 

^^&^)$%nooc{cAt)£friz> g mmmmi, g mmmum^noobxwta 
£tifcir^<x<D nmmmw.x&z>>&^fet£\\ mmit^/vm^^uioodc^ 

[0089] &3b\ ^M^^/V^^^OOc}^ g^lPB#te^^lOOb^^^-frT, ^ 

[0090] ^M^^e^Vv^^^iooc-e^Hi^^ g m±.mtmMm^ miakjt<£ 
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[0091] ^<DM£^7C^MiEg|$100dte, A^^fc @ flliimM^f^iPWBft^ 
[0092] ^*^^#^MiE§P100d^fe^^^^MlE_h#:f5AM^(DplI#iett, 7 
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±miLmmm<vmmm<Dm\ g mmmmm^ioobxwm^tit'^ g mmm 

[0093] 7/WE-7*/V'MjES|J100eW: % fl&ftjfcftu #C<£>D1— D3(D#:#3r?jStM1-5J;5i£ 

D2) I©ZMP ( g fJlZMPcD l£^<9 IcffijE g «^^^E— ^h<S:3&£&iir5£.£ £ 

D3) *S^77K W^^*H^7K¥^^fF^f5ffl F*3 fcfcSo 
El) BulE^^^c^n«jE^(0_h#:^e^^^MjE*r6o 

E2) BfrfE^{5L^^MlE#^(D_h#:f5A«^^ttiE-f-§^*^, g mZMP^<0(D 

mie g ^s^^-^hsrm^i-s ( g m^K^m^^) o 

[0094] *Ml0«(OHW^-e^, Dl— D3©&#£3RJ£i-5J:5fc:, E2(DM^||ff$^ 
mifi A #35 (CJilgLfcPCTB |g^M^$RWO/03/05 742 7/A 1 KTiMW 

[0095] Bl4^MoT, ±&<D £5 ^^tl^MlE g £S_hfW&:S^i^ g IZMP^I9© 
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[0096] J^_h^^^^^gi00(DtE^-efe§ o ^*d\ ^_hf#BJ!Lfc#W^J?£!»100<D 
[0097] 

[^mw^n] 

[0098] El6te N ^lUife^H^feit^^lie^^VK^^it^b-CV^o H^cD#nC r. 

IbLT^U M*5, 5^gg$|36(Z)|l|^^|ll§LTV^ 0 r<D|2|6i»(DEIB (Umit 

[0099] El6<D:^|f&^^>k<Di2#:fC^3mte, ii^cD^^^H^J^LT— ^l^fe 
f*Jt&3mte, ±#:30f^e;££— ifcLTVv-obJ;v^ -tiaiI4?>o 

[oioo] ~<D^mk^"f^comt>m-i. ±fcK&3mt, -nz g mzMP&^i&bvxmm 
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M) »m (z«) sr^tf spffi-c, v ^®zmmm) -c<Dmwijma:f±mifcirz> 0 

[0101] ^*d\ ^waa^-m, &m<D&mxicttLXd2x/dt2i&&mx(n2ffiWtftm&Miik 

[0102] g : m^PM, Zb : ifrf^O^ilti, Xb : _h#:fC^<£>7k¥$^ mtotal : 

^lOK Fx : flc^^ffefr (Pb< ttMiiJfc^© ftl^ ft (X#) , 
Fz:J^S^rp v [i:^(Pb<«MMH^^I&[i:^^(Z|6)^), My: SIZMP 
£t><9<DJ^D^-^h (PU «*^^^-^^h(Dfe^fi (Y#) *fc>9j&90 , 
Xzmp: BMZMP(D7k¥jiLW:s Zzmp: g mZMP<D§&WMMo 

[0103] 

Fz= mtotal * (g + d2Zb/dt2) •••^01 
Fx=mb*d2Xb/dt2 •••^02 
My = -mtotal * (Xb-Xzmp) * (g + d2Zb/dt2) + mtotal * (Zb-Zzmp) * (d2Xb/dt2) 

•••5£03 



<D^Ui^Uzbb^03b^h±i^M^3m<D^^m^b^^X^^bbtj:^ o 
[0104] ^*d\ ^lWlOlij^f/Hilf^^f/^Lfc^, m««P#:2<Dj£ 
¥22<Di&&KhW&&&ttfr3M&^'r/i>'bL-X-k^\ *fc, ^!lx.^±#:3^_h 

[0105] ^:(^i^ii^B^*5^mi^^7nMM^/v^M>r§ 0 07 (a) , (b) , 

(c) <D&w<Dm&. mimrnmR^mmi^^wnEm^/^<omm^v 



WO 2005/068136 



29 



PCT/JP2005/000022 



a), (b), (c)(D^IJ^i-n^VM}*. mmW-2, 2£;fe£^ft(Y$[^fa)^-< 

<D~?h% 0 z.<Dtc#>, mm^2, 2\-±mm±., m^o-cv^ Q 
[0106] mi%mnm(DmimtakjmiEm^M-t. o#vn©i#:3iiMt5io(Z) 

[0107] ^<DMim$.^WijEm^7*^(D±t$m&Alb, M¥ff,£A4, A5£te, -^rtl^ 

H6^^bf'fiffS^^k^^>(D_h#:a^3m^{i— ^{CfiM^o 
«ff^A2, A3J2, #P#:2(D^cJfi|y^24^^«^@^^$^n-^7Vm 

, #M¥ft&A4, A5*3«tt^#^:JBi!tt^CA2, A3(D®*(Di^fP«, m^VM^JC 
imtotalt— %ctZ> 0 *fc, ii^Jt^Al^fCftte, ±#:3(D®i(D{^\ MJ»5, 

[0108] ^lt, ^i^^#Effl^^/KD^m^sa®^«, fesgifa^i^miMW 
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x\f^(^.(Dftx>.mu), (b), ( c )<D^m<Dmi&i£&5zffijEm^7*/v<Dmxfe 

A3, A5tMoTV^)o 
[0109] fe"C, ±{£W&AL #J£¥©jSCA4, A5:|oJ;t^flM,£A2, A3<Z>f@5:(Df@*j- 

[0110] Il^TnijEffl^K^tf^Al-AS©^-/^^ OfcfcH 

3fc©fc&ivcv^o ^l^ifeMcolii^^MiEffl^Vv-e^, -t 

(Djt&Al~ AS^^^fi^^o^g^^^^ce^Vvj^^on/^Vhi^^^:^^^ 
^g, i-*fc*>, ¥M^^^V^±f«^3m(Z){ig(^ri-/VVffitl^-e(D^g) 
£— ®rT3J;5^ ItkAl— A5co^a— /^ilt©tl«^. r<£>4§ 
£\ BlflBb^5^1^^C7cMiEffl ; e'7 2 >^®^Al— A5(D^BS(D>f=B*j-^e 

[0111] Z.(D£o\Z.sfn— sWmW^X<DMM.Al~ A5<DifcM&mto&£ J ?AJfr&\Z.tt)& 

[0112] ^i^ifeM^^±fEoj;5^iMi^:7cMEffi^VV(Z)^*(D@ag^ 
«>5£v^£kJ\ IiftteiiEffl^f;v©gi(?)Et(^n-/^MI^^© 
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o 

[0113] 
[0114] 

tons] mzmimM&MK&tf%M2mffik^jEm^/]s&mwirz 0 msit, ^<d% 

^frVK^— v^Ib^o^TVV-Cfc^ €-S>^Al— A50Sii:. €-fr£Al- 

[0116] i(Dm2^fi^^#iEffl^^>v-e«, mimWtjmiE^"f^(D&o\z.xi^yY 

[0117] sijcDgv ^«rr*u* , m2miaxjtmiEm^/v(Dmm<Dnm (yv—swmm 
m^m* (2) &wtfeistix\ ^ttteZo ^<Dm^mmM$kw (2) ««§p^ \z& 

[0118] 
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[0119] 

[0120] M^S^ ft#(Dlp0# g S3S»d^. _hfBS^W^m^# (2) l^otl2 

fc^j^5*Mfc©EB ^— i£rT3 £5 t-^2^fi^:^cMiEffl^^>KD 

£fW ^ ^-x.^tvfc^2^S:^:5cMiEffl ; eT : >v<Z)^^(Z)lE®^— Sr*-5J:5fcl8 
[0121] li2^m^*iE;B^VW3:, ^l^^7nMjEffl^e^>i-^m«ib-CttffE^^ 

^Sr^f J:5(^^$tb5o -tUcoV^te, l¥«#3£-r3 0 
[0122] M^TS^ ^W^on^VM^JWft:2«^^n6 @ SgSrfco©-?, P5 
M^22, 22<D^g^#3oJ;t^_h#:3(D^g^#^^^ / ^ N n^VMOP^, 2 
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[0123] /^*d\ |^ft©tft?g-ett, iWft^e^vK Hl*5J:^2^fi^MiEffl^>v^ 

[0124] jjcic, mimm^mx-<Dmm^mmoo<D^m(Dmm^x\)Mci^m^mir^ 

>t^Op#:2^i^bT^^m^«Wf*2^^§^(Dl#^g^^(ti) 

[0125] ®9ra\ #^^^giooo^-r^/v— ^mm^irm^t^v^ hx°& 

$PM» At#fc. S0143&^S32*-C©«!!ai&Sjft«Jjg$H5o 
[0126] S014(D^^S016^it^, S ^fc5/D^^CTJ®r£*K 

[0127] soi8te:iit?£#fctt % ^WJt^otuj^bLfcm, so2o^itA/-e^im#Wco 
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[0128] rcDS020(D^a{i, M£tt*mMmA&fttemmUZPCTm^Mte&WO/ 
03/057427/A1 (^T> ^^fcfifcltV^) <Dg|13(DS022— S030^J^i-^ 

[oi29] m%i-tz>t, mm<^mx^i^m^m-(D^m^^—^^^t^(D^m'^ 
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o22-so28(DMa-e^, ^m^fDi^f^fDfcm^ wM^/^m^m<Dm 
BLJiTk^m^mm {^m^mmn^^mmw^hmts^fi^(Dx\^\ ^ 

[0130] #CV^ S020(D#] ; JS<D^ ^f*S016(D^IJif^^:^NO-efeo^^^^{i, s 
022^it^Tr, 4-[U#^pB#ft^^i-§ 0 iOMtt, Bi]fEBl5(0 g tlPB#ffi 

i ooh^xxf^m^^y^^±m^noocx-mn^ti^mx-h f o, S020 

[0131] ^(D^Ste, J:^*#:^^{»fB^#^:mi«Z)g|13(7)S032(7)Ma^^i-^ 

o-e$?«9, mtemjcmkmmfcftibtiZo ^ti&mmmmwirti^ tfrfBso2o 

nm±mzmmm<vmmm*®:m£ti%o ^x\ ^m±w- 
$Lmmm<DmmmzmL,xm%iirz>b^ n m±i^m^mmm^mmnmxn 

^lij&^firfE^oi^ib^^ 
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[0132] ^*d\ Mm2im$:W!ll<Dmi3<DS032(D%imX*^ &Wk^/V&&m<DfiiBijj 
[0133] S022<DmmX\ «($lJ#MW Atfefc) , &»<i£^#!:^$tL3 g^^(^[U# 

[0134] #:v ^\ S024^S/u-C\ ^^Tc^WMiEi^^Vv— ^^^^fri-^o ^<«{i 
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[oi36] ^x\ mimmnm) ^^mm^mmnmxn, m&zxt 

[0137] £9PL<ifcKt-5£(-rmmil;6fe^^ 
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[0138] ^l^^MEffl^>VT^^$tl,fcS^#W^^#^fc^V>^ 
[0139] 

[0140] 

o 

[0141] £fc, &#2l£||^5flfffB£Mb*»W\ l-Itlfe^iEffl^f/K^^f^l^ 

7Vf)U^—^^n^m^(^i^^m^K4^—^^n&tix\^m^ 
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[0142] irf^ib, #«%lliEffi^f>©#f^[C#5^«lttii, &Qt^<DM 
[0143] #^i^M3Effl^>(D®^^#§^ail]*^^oV^MM-r^i:, 

[oi44] z.<D£?i£ftmnmm&femi,tib%, xm^<m^.^ mmmkytm 

[0145] *fc, S'J^B"V ^5r1-*U£ , #^2te, ^l^»7nMEffl^T ; >KD^-«^(D{i 
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roue] ^rb-c, ^mmrnxmrnr^mm^mx^ ±m&Qtemx.& @ izMPi^t 

[0147] ;£^0#(Z)^;!«tl^te, JifBUTc&K, J^'M^^MZEffl^/V^JC,^ 
fig S/^rSr#o#^^«, #Sito|fc|Wt-: ^Srto#i;^©g$i& 

[0148] £JIT, 0lHJi^^'^(DSO24(D^VV— ^&M&&10ttmsCM t {&#l\Z.'fo 

[0149] *i\ S200^*5V vt\ ^E^tw^^b^/W^^^W^HE ( n ilfrfifi 
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[oi5o] #:wc\ s202^h<D^ : m^mn^ti, mimtaxjtmiEm^Mz.n^xmm^ 

7cMiE_h^gPb2*5j;^^5cM3E_h#:^ 0 b2b^Xtkj£&fri% 0 
[0151] ^b^JBBtCtt, *T , S202^*dVvT, MW&^lEliW-&n?b2&£X$mWt 
7C«iE_hf*:^#0b2(D^^M(Pb2_s, 0 b2_s)^S« 0 #J3M&J$ (Pb2js, 0 
b2_s) te\ ^IH^JtCm^^Jt) -C(D^^7cMiE_h#:^gPb2*5j;^^7C 
fE±#:^# 0 b2^«^^Mfi:t^@^-r^(D-efe(9 N f^x.{moj;5^^ 

o_hft:fiBPb^(D^(^g(Dm*) m\mmm (mmmmmm^mDt- 

jE^fc^m 0 b2t^mk^"f/v^m-(r>iiw^m e bt^w^^^fto-rtiW) n 
, mmmmt- Att© 0 b2^ 0 b^^^j£v^#;L«btL3 0 -t^-c, m«(p 

b2_s, 0b2_s)^^[U0#^Jt-e(DPb, 0 b£, tfrdlBt^Jt- A tX<DVb, 0 b(DfitPb_p, 
0b_pi:. ffr[U^iJt-At-e(DPb2 ) 0 b2<DfgPb2_p, 0 b2_p^^^^J;«9^i-5 

o 

[0152] 

Pb2_s = Pb + (Pb2_p-Pb_p) • • • 5^04 

0 b2_s = 0 b+ ( 0 b2_p- 0 b_p) •••^05 
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&\^X\ S204£r&T\ S206— S216<D/V— :/#yffi£rl£fTi~5o S206-CJ3:, MW- 

^jtm^-±-mtmMm(om^(D\^m (Pb2_ s , e b2_ s ) t, ^mmMit^(Dmm^ 

fsv^m-v) Sii^M¥ti^lrS(^ |g2^{AL^MiE^Vvw^iC^Ai 
-A5tf>ftg£jJ<#)3o £<£>i&^\ ^2^fvL^C^MlEffl^T : >-e(Z)n#5/hl(D±#:3 
<^i©^f^^<^«(Pb2_s, 0 b2_s) (£— JLo, ^2^5L^C^MlEffl^ 
^>V^(Drl#^^^l(D^M¥22(DOT^#^^^t:ce^>v^(D g fl^^ig^ 

Pb2_s, 6 b2_s) -ee#m^-fc««]P^d^, ffjfBSM^W^m^# (2) l^ot 
, ^2^{i^^MlEffi^^Vv^^tt§^®^Al-A5(D^^^^^§ o 

[0153] Hfl^m, M¥®^CA3, A4<7>f&g«, g ^¥^^#^^£^0 * 
fc, _h#:Jf,£Al<DteMte, f^M(Pb2_s, 0 b2_s)^ib$:fe£tu _hf*3 (_h#:y^) 

wmmmtm^ (Pb2_ s , e b2_ s )tfrbmti%v^yhi(D&mi*2CDmm^ikfe 

n^ti^n6^mm^ir^(7)x\ m^22, 22isxn±i^3<Dii.m:^^^n 
«\ &ffli*2(D&n<DtiLm&m>—mmzfe-3iz> 0 tot, ^mmkytffiiEm* 

^JfilfC^A2, A3(D{ig^-aWt-^^o 

[0154] #cvve, S208icm&, ^im±ikj^sEm^^tm2m^j^iE^"f^t 

7tffilEm*r7*/l'<D&n&Al— A5<D@fi&*jh/^h/mi(i=l, 2, 5h 
g-<^h/k)^Pil^b<«Pi2(i=l, 2, 5)-e^*fo Pil«^l^{*^7cMiEffl^ 
f;Wf^Ai©t& Pi2«^2^^7cMjEffl ; E-7 f /KD®^Ai<D^:»"efc5 0 * 
fc. ^l*5i^2^^:^MEffl^T f /v-e(D_h#:3 (_h#:y^) (D^Wftttiftse 
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m e b mmmm)tm—?&z> 0 

[0155] ^^>ra^fi'^T^Gc_err^^^^>^^»»*»T^L_err{*, tfl^fl 
[0156] 

Gc.err = 2 (mi * (Pi2-Pil)) • • -^06 

L_err= E(mi*(Pil-Q)*(Pi2-Pil)) + Ib*( 9 b2- 0 bl) + Const •••5^07 



[0157] z.frih<D^:06, 07\z.^\^x^0Q(D^m\^mi^mkj^MiEm^;v(D^-'K 

>^A1— A5(D^gPil(i=l, 2, 5)K£V)fe^%±fcM>b<DfcmtM2mmjk7Z 

MiEffl^e-x/KD^M^Al— A5<D^gPi2(i=l, 2, 5) ^i^m'\^(D{iLmt(DT 

[0158] *fc, ^,07 <D^m^h^ const j^m^tcm^ miMtak^miEm^Mz.n'r 
%n2m&7kjt^m^^<Dftmmmm<DB%n&mmirz> 0 rn^m ^&im 

{3\ ^07<D^ri22d^rConstJ^|^V^II^, ^l^i^MlEffl^^VKD^^A 
1— A5^5LgPil(i=l, 2, 5)^2^^MEffi^/KD#a^Al— A5 

, m2mm^miEm^Ty^(D±m(±mj^)(Dmmmm^t^tct^<D, w,2 

[0159] fot, ^>V^M!j*aT^L_err^^ 

#M£2tfWc£*b3r££&5 0 
[0160] ^-e^:07(D^a22(DZ^^<^gallrt©II{-oV^TM^i-^^^ (Pil-Q)*(Pi2-P 
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&o ztv&ffistmz.m&rtitt. (Pii-Q)*(Pi2-PiD«. inwiiK, &m& 

u<r^»it^#bfc#H^^©ffi^©2ffip©^$©ftt^^-r5o Hire 

, 5)<^fcePil, Pi2^Pil(Ai),Pi2(Ai)i:V^J:5^IB*L-CV^ 0 
[0161] Aa«J*^^B8i-^^07^gflbT«, £*WE>ffcb0fc:, ^08— 10(DVvf 

[0162] 

L_err = 2 (Ci * mi * ^ Jg(Pil_Q_Pi2)) + Ib * ( 9 b2~ 0 bl) + Const • • -^08 

L_err= S (mi * (ff ^AiO^^^^ft * Ef&)) 

+ Ib*(0b2-0bl) + Const •••^09 

L_err= 2 (mi * (M,£Ai<£)zk Wc^te * * C(|f ,£Ai<Di^£)) 
+ Ib*(0b2-0bl) + Const --^lO 

^08fp(Dr^S(Pil_Q_Pi2)j«, fll^i^MiEffl^VvOlt&AM 

nm&MM1rz> 0 *fc. ^oscporcij^Bif^^-efc^, Wft^, ci*mi*^ 
S(Pil_Q_Pi2)^ N M^^^MEffi^e^/v^a^Ai^^Q^-e^^tb^H^^^ 

B^(Z)2f§^m^L<^J;5^^:^tL§ 0 ^09*5it^lO^*Dit§r^A 

i<D7k Wc^teJ f*. ^i^^C7cMiEffl^7 2 >v<D®^Aii:^2^^:^MiEffi 

fcfePi2-Q(Dm\£$.ft%:Mukir% 0 *fc, ^10Orc(if^Ai<Djlg$)j«, f?l£fcte 
^2^{i^^MEffi^^VV(D«^AiO^Q^^--r^ffi^f^$(Pil-Q^»Pi2-Q 

<^i&[t:^^)^fe5P^e^#^i-6o smftc(®^Ai(D^$)», 
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[0163] ^®t!)M^M-t-§_hfE^:07-10(DV^i ;i! tL^fflV^Tt, W^CO^m^Const 

[0164] M^i"^ #iffB:^07~10<D;&52<D 2 ^<#lj02. Il^jciiEffi^f 

^^^^O^i-^S(Pil_Q_Pi2)^^-LT^f»M^^^i-§Mmt^o 
[0165] ^^W^W, S208^3ol^C, fiTfB5£6(DPil^S200^fefcSllM£^^ 
MlEffl^f/KDff^Al^ A5(D{iLg^ft;Ai-^)^#^^ |D^:6(7)Pi2^S206-e 
^fe^«^Al-A5(D^^Ai-§^^r\^^Vvr H «^^gT^Gc_err^ 
^m$tt^ 0 fiffE^cDPil, Pi2^6^|DC^i-^^*^, 0 bl^S200-e^ 

[0166] ±xt!(Dj;5t-S208^*DV^-C, ^Ty^^foM'bTtlGc.errb^^mfiTgWlM. 

tlL_err^^fc^ S210}31jt/u-e\ Gc_err£L_err£^Oj£#<D}ff^falSft 
l-foZ^frtimWx^nZo ^TbT, 'O^IJif^^YES-efe§^^« N S212£- 

A/~C\ ^fu^:^MiE_h#:fM^»m^»^tt (Pb2_s, 0 b2_s) (Difiiat^^© 
M^M(Pb2_s+ APbx, 0 b2_s) N (Pb2_s+ APbz, 0 b2_s) , (Pb2_s, 0 b2_s+ A 0 b 
)£$r#>5 0 APbx, APbz^^tLW^{i^^MlE_h#:f5Am(D^MPb2_s^Mfe 

mx^ 0 ^LT, ^feCD#^M^>^bT, ffflBS206, S208i:[^CMa^^T 
[0167] ^CV^ S216^iiA/-e\ S214-e^*fcGc_err, L_err^{^, -^fbOfji/^O^jfi 
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[0168] SX±l(D£51Z.LX^ S206— S2160VV— ^tOMfcX^X, Gc_err£L_err^Ojff# 

[0169] -^LT, S210©^JWfife*dSYES^5t % S212^S"CS218f31it^, ^&<£>(P 
b2_s, 0 b2_s) tf^rm B#^iJt^*5tt ; 5Mi^:7cMlE±#:'fi®^#(Pb2 ) 0 b2) £bT 

*3<„ mi2feM2mzikKmjEm^^<D&m&Ai(i=i, 2, 5)(D&m&£Tf 
mb^v^^fu fBso24^tiEUev ^#^) \z&vzm2&mk5tMjEm*r7 s 

■7 f /KD#®^tAi©^:«*3j;tJ«_h^3 (±m>^) <D^mfib(DM&&M^X^Z 

if^o r<D#-^(D^2^^MlEffl^-7 2 >V(D^^(DBa«{*, Hl^BJ! 

^*5it^)M2(DlEg^ffi^i-^(Z5-e^ 0 ft**, Hff|EEH2Ti*, fM{^f>^ 
^^*fi^i-§^2^fi^MEffl^T ; >KD^-a^Ai(i=l ) 2, — , 5)<D{£g£P 
i2'(Ai)T*^LTV^ 0 

[0171] *fc. 013^JL|ELfc^^5c^WMlE^^/V— ^^^ioT^r^^fbS^f^ 
5nME^^^i-^^2^^5uMEffi^^>V^#®^Ai<D^g3oJ:t^_h#:3 
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[oi73] Bii2^i-^j^v^T, wmt^/v^m^n^^B2mmkjt^iEm^ ; f 

/V<D&W&Ai<D$LmPi2'X^ MWf*2, 2(DfC,&A2-A5(D5^ ^SfJHKW©® 
,£A2, A4tt, IlIt^TctlEffi^f^^^LT^f, n^hlOfff^RiJ^® 
Ttl/TSo ^2^{i^^MlEffl^T ; VKD»#J(Dff^A3 ) A5J2, 

^,^2^^MiEffi^>^(Dn^Vhl(D^#:m^^^l^^MlEffl^ 

v^srrtb^ pw#2, 2<D&K&A2-A5<D^/^mmisi&ijmmz.£<>x 

&MtiA2-A5&&&1r%m&t><D&mt>)&fr ( = #« ,£A2-A5<D«M * ^ 
#SJj&A2— A5<^^e-7 i >r^«M3i^5iS^J;oT#a^A2— A5^£i-5'R 

[0174] rfUCfcfLT, ttf|E^^^5n^^MEi^^>V-^^T^^^^M^^^^ 
i-602^^5nMHffl^^>(D#®^Ai(DM^oJ;rj?Jbft:y^(D^^^ 
3£Uh£#tCf2, mi3KH,htl^0K, MWf*2, 2<DfC,£A2— A5<DM^<D_hfB 
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[0175] z.<Dfc#), mm^^&m^MJ^i-^2mm^^iEm^/^<D^nuAi 

[0176] z.thK£<9, ft^TnU^fi, m^^>^^1»Ji:£tL-Ci v£v ^Jjip 

[0177] *fc, sii4«, mm^r^^m^Mir^m^^w&^mtmm<Dm 
p^m^^mmm, 2<Dmm%%mfx, ±m^ri<f^m^mxm, mi 

4(a) fe\ n^VMOiliiitl, Bll4(b)«TO^ftif-C_h#:3^Tif^lS 

mkTtffijE^bfemg—gcU W^ttt, 014(a) ^-r&K, 0ifej;^2^ 

{i^MlEffl^^>KD^-«^Ai(i=l ) 2, 5)<Df£gPil, Pi2$o£Tf±t$3<Dm 

[0178] ^(Wflga^ nmzMP&m&vtc^^m&Tifzxtt^&^mirzt^, 
±Lmmmm.mm) »^Lfc«, _h#:3£-nf 3#^^§ 0 lot, 
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(a)«H£gj6^T^5o -tbT, ^tt, MP#:2, 2«|Mftfi^n^VM(Dtf)^#J 
fc^fflS^fcfcl^JSL-C, m2^5L^^cMiEffl^7 2 >-e{i, W^fljglC^A2 ( A3 
<D^gP22, P32#^ mi^^L^k7vW^Em^^(D±mK^A2, A3(D^gP21, P 
31J;«Jt>|gi4(b) ^^•r^n<n/^VM(Dttf^{l!J^g^^ 0 r<Dfc#), M^l^Ctc 
MEffl-e^>-e^#:m>L^-^-l3:5-<< (ffffB^l^Yi^MK) . JH2^m 
TcffiEffl^^Vv^i^K^Al^gP^^.^l^^^MEffl^^/v^-hfr 
«^Ai(DMPiiJ;«9^m^fiiJ^Mf3:^ 0 StJowv^^i-tL«\ M^J§ft£A 

2, A3(D^^>vrHlMaM»M(-#5«tt^^Mjt^lj^^^, ii{*IC,£Al<D^ 

2^fi^^MEffl^^/KD_hf«^Al(D{5AgP12», ^l^^C^MlEffi^^Vv 
Jif^e^AlfD^Plli^^^^llJO^g^^ (Wf*2, 2(D_hf*3--(D3g|^f|S 

[0179] r<D<ki|\ ^^_h#:3(Z)^#^li#i-§<k, Jgl^i^TcMffi^TV^JI^ 

ot^, ro^^vv^^aibi^-rtt^^ gii4(b) \mm:tt^2^(D=mz<D 

mtcir^O , ^2^fi^MlE^Vvw_h#:^#(g| 14(b) ^H^tr^i-Jift: 

<D±fommm 14(b) idnt^t±#:3),t^^, ^M^^w#^o_h#: 

[0180] -j&ftmv^tf, #Pf*2«Mtp^^ W#:2(Dj^g@^(Dcp^^M#B@lfi©tp 
>il^^^a^WbTn^Vhl(Dii)^#J(^t:mS{5^\ 121^^^^ 
^>KD_h#:«^Al(D{iAg«, v^yhl(D&jy{MK&W)U _h#:3(_h#:y^ 
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[0181] z.<D£5 ^m^^A^mz.MLxmm (±m^mmm &&mj£&mk7tM 

[0182] irt^^Mot, tff^^O<^fi^»«iE^/V--^^mTb/cm, S 

[0183] #CV ^\ S028^3l^-C\ ^/^^/VMlEffl (m)fB^/V ; e-T ? /VMiEf|S100e(D^i ; S 

[0184] #Cl ^X\ S030^3tA/-C\ ^/V^^/V^ffl V ^zM^E^^^T^o '©Mii, 
j|^l(D|1113(DS038(D^a^^|— eS>*9, |W|^IBJCi^l^fE^tL^*5«9^||=ff$ 

[0185] *5b\ ffffE^/v ; e-T ? /HiE§Piooe-efflv^^/v^^>v{i, mx.l-£mi5iz.7jkirim 
<, p^M©±*3, #P#2tf)flS:li|giu ;Wfi§y^ TJffiy^, ^¥2 
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[0186] $i±$k *mmteMizteiir%m&^&mnioo<Dm&^&t&mx*&z> 0 
[oi87] mm4^mmvxm^^T9^T>^mmmioi(Dm}i¥^mvx^< 0 & 

io-277969^^<^^P^a^fS4!c$ti,-cv ^cox\ ^mMiWxfeWm&Jtem 

[0188] £fc, S (flat) , § t^ZMPflJt ( S *^#Lit) , *3 

iu? a m&feBLti mm cmje a ^szm^-^r^ a i^k^m^) ra\ 

a£e>*L5„ ^rb-C, a^^5>BE^106-C,^^«#J£ 5 P22^BB^ a*H 
104fc3S£>*v5o 

[0189] ^=3^^T>-^»fm^SBl04^^. ««#tiiES|£W 
@^J£TO©^#«,#P#:2(^=3>'7 p ^T>'^a«72^^^(#P#:2^^ 

^ a ^i^S^ Kaffi^S £5 t-^M¥22(D a ISWII^iELfA©^ 
#5£i-3 0 n#yhSSMBr^7 f /H02H:, a m±ffiffi&& ttftat) Mfit^*« 
##^IEa^M¥^S^(fLm)i!^A^$^i!, JttiASrWM-rSJWl^, 2<D 
12i@(DMfiS(DMtP^^(ffi)^mbT^=t>'hn-7l08^^ o ^ay 

ha-9io8«, n#yb^^^io2-c3st (fit) £ a shuc 
02«, am^#^Mi-^i^BifiS©^^aii)^WL-c^^^hn-^i 
(ft) &• a mmtL,xv7$yhi<Dmit<Di2te(DMffi<D&&&mftmfflirz 0 

[0190] n^Ml:4i:fci^ (PlXf2l£#M0cH;*7) 1±6Wj]'K>"9'50te£<oX1km 
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#VM 0 errx, 0 erry (PL< « § £S_hfl^ifrfc 

§1511 2X\ n^M©±M^^S «_L#85iW§ K«7n-r5fc«>© g 

[0191] «^^°^TV^»]fm^l04{*, ^jE$tbfcB«*S^^ •fe^^mffi 
«#»iE g IMTttli (#Lil) Sr*Si-5o fc^bi~-<-C©^*S: g 11^- 

[0192] 

[I2i»u 

mtm— c\ fMi^f/v^i^iiie^xMEffl^f/vi, mmtk&mmoo 
<DW&<D—&b&$gimmj&mkmmirzh<D~eibZo tot, ^mtogtBo&w 

3—mi6mm<D—mm^mxh^ 0 
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[0193] gu6tt, ^mMMM^mmik^^mt)^?*^) otim&^u min-i^ 
[oi94] mi6\^ir^mMftm<Dwmk^7*M^ u^ y bi<D&mfo2m^<te&mfo 

2<D^-22) lZ^tl^tlMfoir&2^<D% 1 ^'S;&2m2, 2m2, RU±i^3icMl^ir^ 

^bm^ti^T^xm. mm^rnxm^mi 1 \c^tz.^T^tm—xh^ 0 
tot, ^mmmx<Dmm^m,mnmmir^K ^(omm\^nk(owox^ 0 

[0195] 1"Jfe:b*>, ^(D^-Mlb^/V-e^, ^^«^2m2, 2m2<DWiti^{mmtm&tl 

b-c— m w (cue*s^c (±#;3 k m ^fitz.n—^;vmm^h ±.x(Dibz> m& 
— m^^^u(^22Kii:M^m^nfcn-~ ^^mm^±x(Dh^m^M.) 

KWtfe&frX^^o ^-«^2m2, 2m2, 3m2(^WA(Z)^fp^, n#VM©II 

[0196] ^(D^mt^^<Dmt}^m^^{mm^n^)\^ ^t»5£h~i3^j; 

i3(D^^:«^T^J;5^^a-r^o 

Zsupr^PM^JC^lSM, Zswg: W?f«|, Zb:_L#«A#& 

mzm. xsupi^&m&y-n&Tksmm. xsw g :mm^w^^mn. xb:_h 

msup:^^^®^®fi, mswg : »P^¥f ^fit , J : 77^*^-/KD'tH4 
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Fz = mb * (g + d2Zb/dt2) + msup * (g + d2Zsup/dt2) 

+mswg*(g + d2Zswg/dt2) 

Fx = mb * d2Xb/dt2 + msup * d2Xsup/dt2 + mswg * d2Xswg/dt2 5^ 1 2 

My=-mb * (Xb-Xzmp) * (g + d2Zb/dt2) + mb * (Zb-Zzmp) * (d2Xb/dt2) 
—msup * (Xsup— Xzmp) * (g + d2Zsup/dt2) 
+ msup*(Zsup-Zzmp) * (d2Xsup/dt2) 
—mswg * (Xswg— Xzmp) * (g + d2Zswg/dt2) 
-mswg * (Zswg-Zzmp) * (d2Xswg/dt2) +J * d2 6 by/dt2 

•••5£l3 

[oi97] mz. mi7^mmvx^mmnm<D^im^^iEm^ry^nmir^ r 

1, ^Kff^A2, A3, M¥«^A4, A5^^^^5«^^^Vvt?fe^ 0 natfs* 
l<DJift:3(_L#:y^)#\ ±#®^i©£;bijfc>f*-— V^0eta~E~ p^WlbSrfc 

^H(Z)^i4oJ;rj?^2^^:^MM^T ; >^^l#, »j&Ai~A5M^~^£t> 

[0198] ^(Z)i^, _L{«,£A1. #JS¥M^CA4, A5tt, tf|B^llUfe^1!R©^ltb<tt 

22) <^gg$f&fc^jSLT— i^fc5&£5^ (^©mtS^f^K-Sr^S 

3pJC,£A4, A55oJ:^^:JSi®^A2, A3<DSCM<Z^nte, P^VM<Z>|£JCMni 
totals— i6:i"§ 0 iif*fC^Al<DjCfi^ _hf*3<DfCS<^3:£\ MJ^S, 5&d 
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[0199] ^rLT, ^IIW^IS^*5V^Tt>^l^{^A^^MEffi^T ^ /^(D^^(D|em^^^, tb 

;vxu, n7j?yM©#JWifr20J8?HaSr, mftfo2<D^mB<D^fohm%B<D$* 

[0200] ^db\ z*cHff,kA2, A3fi, ±fcftftMfrb±m&fttmfittfafcffife<D}fcM 
[0201] ^fgl^^^MlEffi^/V^ff^Al — A5<D^n— /V«^±^ 

ft<D\Hft&tVX<D&±mW&A2, A3<D^u^Wmm^X<D{\LW:^^o 
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[0202] m2%m^m<DmiMw^jtMiE.^"f^-^n, ^©i^ai- ascd^w. 

[0203] ^2^W^-e_hfB(Dj;5^^l^^:7cMiEffi^e^/V(D^m(DgB@^ 

o 

[0204] 

Effl^^/V(D^(D5^^-h#:MAl*Dj;r^_h#:y^(0@Sg^ N ^x.ibtWcpB# 
S¥tSi#I^JSLt^iait- SfcU lo, ^JB§fC,£A2, A3<Z)£l®^ 

[0205] 

[0206] /^*d\ ^«tg-Cte, l2i|i^7niiEffl^f>0«i||i, itiffEEl8^Uc 

ifr^ffijEm^Sl'bmm^ -L^fC^Al, iWfilfC^^, A3, *5j;tF^:5]ZK^A4 
, A5^TU t/c, ±.m>^K4^-— v^Ib^boTV^o ^(D*^ _L#:|f,£<Al, 
^¥«^A4, A5<D, ^1-§Mi(_h#:3, #J£^22) {ZMfeZfrltXi—jJ tVM 
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[0207] ^»^t§ (m2mmnm) te&ftz&&&j^miw<Dtim&mmzfo 

[0209] ^rb-C, S018<DmZ-S020<D® i mtfmft tsfrl. ^0^<D#^/-^— 

13<Z)S022— S030<D^mtm—(Dfam&^mMMM(DS020XmftirZ>Z.bX\ 
[0210] m / £mJClgkl<Dmi3<DS022—S028(DmmX^ fei?;^m-<Dit$Lt£b<D 

tjb\z.^ w^t^/^^m^m^Tk^^t^mm^m^xmmvxv^ 

x. limtemJcWii (D m l 3(DS30X^-mir^/v^/vmiEm 

[0211] ^CV^ H9<DS020<D&13(D^ h^^S016COmWx^^'NOX^tLm-n- 
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[0212] J;«9*#:^^{i. ffflBS020-e^:^L»^^-^^S^, IISMIi 

^mm^itmm^^^mmx^ m^±m<DA^unm&^m^x, nmzM 

[0213] /^*d\ so22<D^mxm\^^mit^7v^m(D^K^^ / ^mm^ 
wmso20(D%mxm v ^wtm —xxx \ 

[0214] #cw-e, S024\zmAjXm±lkjxMiE'y-y*;v— ^->&mfT£ti% 0 z.<D-y-7*;v— 
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9ffl&jtM Effl ^ ; r/v<D±{£MUAl <DiiLW:fes Wm&tT* JV)fr&v> -bfW£©£ 

[0215] ^[a^M{b^f>M©if$ @ m«b (^[UB#^jt(D^«) a>£>, ^Hit 

^B^^^l^^^MHffl^^>V^#6BUfES^KJ^^# (3) Clot, 

[0216] #cv^-e, s202^^s2i8*-e(D^a^ii=ff$tL§ o ^tb^^^a^, MiMMMM 

o *I»lt1t #^^7nMjEffl^-7 f /KDp?M¥«^A5, A6(D 

IC&A5, A6t^fc>5^f^B&L-Ob«tV\ 
[0217] irt^^Mot, tff^^P<^fi^^«iE^Vv-^^^Tb^, S 
026-S032(DMa^miHW^^I^I#^mT$^5o rtt^(DMS^, Jgmjfe 

[0219] ^|IW^Wti)fE^{i^MlE^^oV>T|l|18^J:U?|l|19^#M 
LTttMfM^L-ejcKo EH8«^2^{i^:^MlEffl^VKD^®^Ai(i=l ) 2, 
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Ai(i=l, 2, 5)(D^g^Pi2'(Ai)-e^LTV^ 0 
[0220] Ell9fi_h|ELfc^^C5c^M5Ei^^>V— f>iaot^ll5l2l 

[0221] EH8^i-^J^V>T, m^^T f /V^^*]-JS-r?)|l2M5A^:5cMlEffl^ 
/KD#@^AiCD^gPi2'-e{*, ^dffi®^tP22', P32'/^ill^z:#:5uMiEffl^TVV 

#j(x«kdie^ir])^6„ su^m^sr*-*^ mmfc2, 2<D^mm^A2, A3 

(D^T ? /k^«3fe»MiS^J;o-C^^:Jfii®^A2 ( A3^^i-3*ttij<DMjt 

^^(=^«^A2, A3<Dnm*^^mmm&mmm)<Dmm^tfiyhi<D 
mfc£<>x&*:MW&A2, A3$m$iirz>m&tift nmzMP&frV)Kfcm~$- 

^fl^— efe5(Dt% |2|18<7>0rm, _h#:«^Al, #M¥W^CA4, A5<D^;Tl 
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[0222] rjftfc*fLT, mmmffik^&ffijEVzf/v—^x^mk^ffi&mcMffc 

e b2-e bitmmmvx\^ 0 m^rr^ mi^mmk^i-zmM&tt^ 

[0223] ^(Dfcfe, ^^^ME#W^^i-§^2^^^MiEffl ; eT ; >^#«^Ai 

[0224] ^^i«9, mm^^&m-it, m&ik^^mx\±3%m&fix\ ^ 

[0225] /^*d\ *lifll:J:5^l:[l ti^yhKDm^Lmm^m^h BMZMP&~m 

m<£yfmmmmbf£& 0 
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[0226] 

[0227] *njfi^ni-ctt, mmfc^Mz, mx.i-fmmm8com2m^jiW^Em^^ 
ms\z^utta<, mm&2, 2<D±mv>?, m&^22, 22^^^^ 

^ffi^^^k^V^^^in#^ N #©^Al-A5(DMB»ft43j:t^Ji#:y^ 

[0228] H20te, ^mmnm^n^mimiL^miEm^^(Dm^^x\^ 0 & 

[0229] ^.(DmiMiL^J^M'JEm^'fM^ n^VM(D_hf*3^JS-r^lO(Z)±#:K^B 

1, ^mm(Dmmmm^(D^mv>^y^mf^ir^±mm^B2 > B3, «pf£2 

05feW(^¥22)(^^^b^i-§^¥«^B4 ) B5, n^hl©# 
^7nMlEffl^^^^o^§-h#:3(_L#:y^) te, ^JC^AlcD^^-^— 
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[0230] ^(Dl^, Hl^fi^C^MiEffl^e^/V-e^JifrW^Bl^, ;Wfi§SC^B2, B3£, J£ 
-A5£HM^ ^^tL^j^i-§^4(±#:3, #^CJfi|y^, #J£^22) 

[0231] /ifc, lll^i^^ttlEffi^Vl^^fC^Bl — B7COMM<Dm^Ul^ n^VM© 
&tM±H?l— C&Si*^ _h#:ff^Bl*5j;«MB6, B7<DHAtf^&fP^ * 

[0232] ^lt, ^mmnm\^\^x^mimta^miEm^/v(Dmmmm\^\t. & 

[0233] ^l^^CTcMiEffl^/^ifrjC^CBlSSir^lRfra^CBe, B7tf> 

[0234] 

Ib=It+Ib 

+ _h«^Bl(D®* * (_h«^Bl^_h#:®^Al^(Dmg|) 2 
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+mftn&B7<Dmm. * mftn&B7k±ftmuAik<Dmm 2 

•••^14 

[0235] iiT\ ^S^JfeM^^^fSOi^^^lMi^TcMlEffi^VvO^^OSa®^ 
%Z.kkm^X&% 0 

[0236] 

iEm^Ty^<Dmm<D5%<D±fow&Bi&£Tf±m>?(DmmK 

#M¥«^B4, B5(7>M^ ^-X.^^«0#g^»»]^^it^n^VM(7)# 
M¥litili-f^L-Ci^fiIi:-SL, fio, ;§-*JfigfC,£B2, B3(D{ig^ 
, ^<b;fr«B# @ fJIMSji^t 3#P#:2<D Effigy ^(D^i^-^LT^ 
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[0237] 

, #«^tBi— B7o, %frmmfr£<otitm.ktt. 

, 02O(D^l^i^MM ; e^/V^lKl— efe^o #-f^— >^It, Ia^g|20 
/McasWCtt, #ft£Bl-B7, 3feTJ«m±^3(_h^y^)*5«tTJ«#IRfr5tti3#yb 

■So 

[0239] ^<D^2^mkjzWjEm^y*/W&W&Bl~ B7(D^n— ✓Vl'JffitRSR'WifcfilJ: 

[0240] ^mm^m msmmmsd K&tfzmm^&mmoocDmm&mmim 
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[0241] jy^a*. soio^hsois^fD^mtimi^mButnm^mf^fi^o 
fflzft%.&£\\ mu ^mm^mx^ so2o<Dmm^noti^<Dmti^^^( 

[0243] #CV^ m9<DS020(D^m(D^,h^^S016COmWf^W:^'NOXh^fcm^- 
KU, S022icmA,X\ ^/<7*—?(S020XfcfeVtc^s<7*—?)&m^ 

[0244] &VvC, S024^itA/-e^^^7cMiE^^>l— ^J^^^T^tbSo ^<D^;V— 
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[0245] #CV^ S402^itAy-C\ ff)fEBI10(DS202^^<^|#t^ ^£^ttlE_h#:{£ 

[0246] ^CV>-C % S404^rS"C, S406— S416(ZVV— :/^3g^|2|10<DS206— S216£|r] 
WkKmnZtlZo -<£>*§l3\ S406. S408. S414<D^S(D— $|3^Jgm«^l§i:*B 

jS-r^o jwwkus, S406i:i^, m^^jE±m±Lm^<vmfe<7)i£Wi(pb2_s 
, e b2_ s ) ^mmmt^<D^mik^"f/v^<D @ ^MTOe^i^j^ § m 

BS^f^S:*^ ^2^fi^^MlE^^Vv-t?(D^«^Bl-B7(D{iM^^fe§ 0 £ 
M(Pb2_s, e b2_s) id— ifcu io, ^2^^^MEffi^eT ; >-ecDc2^Vhi(D#j^ 

¥22^5Ag^#^^^^^>^(^g^AlZ^g^^— gr^, io, f|2^ 

i^f;v^m(Dwmm^—m^x\^t\^x, #i^Bi-B7©tti»5, 5 

[0247] JMfclft^teU M¥Jt£B3, B4©|5iltt, g^MTO«^^^$^o 

, _h#:«^B10{4®«, #IM(Pb2_s, 0 b2_s)frh$kJ£tSfh, ±m(±.m^?)<D 
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mmn. nummmtm-ttsnzo *i^b6, B7<zxim, ±miz 

[0248] *fc. S408<D^a-C«. ^/VM^^^-fttGcerrtt, niMffiJ&mtmmz. 

^^MMWlM^TflLjerr}^ M%.&tftffi£X)7<Dftm<D Tib * ( 0 b2- 0 bDjSrTl 
t * ( 0 b2- 0 bl) + Ia * ( 0 a2R- 0 alR) +Ia * ( 0 a2L- 0 alL) J Xm^K.f^KX 

Bl— B7^0V>T(D^P-C$)§ 0 
[0249] S414"C\ ^^m^WM'L^ti^XX^^'f/pmMMW}Amir i th^M^ 

[0250] S406— S416<D/V— ^MS^^V^T, S418<Z>MS#^^£t l ,, 4*IHB#£!|t<E>^ 
{i^MiE_h#:fig^(Pb2 ) 9b2)^m^fl^o E|10<£)S218^ 

[0251] ±mJt&fflk7cifr&&jEy-'7A^- ^iCioT, tffSB^#l, 2«fct«^ 

^5uME_h#:f«^#(Pb2 > 0 b2)£UTife5&**L5, iti^J;<9, f»^f># 
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[0252] 09(Dia0J^Mo-C, tff^(^^0<^fi^:^»«iEi^^/V--^V^mTb/cm, S 
S028-S032OMa«, Il»li^-tfe5o 

[0253] fc*3, ^^^Mioo^±f&0^bfcJ;5^^$^ g^^A^i-^1S 

^ ^^-rr^fijij^iigg i o i <DHif^ « m mm 1 mm^mt m —x&z> 0 

[0254] ^||»^^(Dtf)fE^i^^ttE#^^oV>-C|l|22^#mbTM^t^ 
iatio< 0 El22{*, f?!j^«02O(Di5^^^Vhl^[t:^^#^^$-frf^|| 

jfefe#(2) l^ot^S^H©yj;otV>5 0 «ot, r<D#^(D^2^^ 

miEm^/v(Dmmmm\^mimm^^m2(DWM.Km^ir^>o 

[0255] n#Vhi<Dg|20co^#^^^, ^ifr5, 5£|2|22<D£5^lt^#J^#ffl1^ 
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m^i^mtcr^o , m2mta^m^m^7V(DAiW- ! KUBi(DitLWpm^ 

m 1 ^i^TcMlEffl *r<f/v<D±fcM 1 (DftMP 1 1 £ QhteXM (D$lWl KftZo SU 

&*3. r.©£§\ ^l^{i^^MlEffi^7 ; Vv(D_h#:®^Bl(Df5:gPllJ:«9t>^ 
^^WcftSr^ttRfcLT, ^2^{*^^MlEffl^^VKD^:JBi®^B2 ) B3 
(D^gP22, P32^, Hl^fi^C7nMiEffl^e^>KD^:ffiiMB2, B3<D^gP21, P 

[0256] ^<D££\ <R^_h#:3(D^^#-r§^, ^1^^7C«lEffl^^Vv^^2 

^Vvt?(D_h#:^(g|22^±#:3(D^) , i-^t>^^^C5c#E^O_hft:^ 
01^^7nMlE^>vr*CD_h#:^#(Bl2O^i-_h#:3(D^#). 

j&bu ±mn&B2, B3&£x$mm&B6, B7<D^^mmn^tmijmm^mm 

[0257] £5 (£**&ffc^/]'^^LT5g»j (_LfWM^#) ^ELfc^^TuM 

[0258] MM-TS^ W_hl^0J!b^i-^3||»^-e«, ftlfELf^^Jgl^SIM^ 
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K^xm2m^^miEm^Ty^(D^mmm^^fcm^K^f^mm2 

ti ( @ tlZMPt^^^^-^b) ^(DMt-Bf S©S^t7tyb (ffffE^07 
-10(DrConstj K^mir%h<D)&1JUX.tlh(DfrK fM^^f >^<DiP|B#Sg»J^ 

[0259] 

a) mm&m&irz>mm%k (^n-/«g^) ©ji^ 

c) ^/v^e-T'Vv^^oTOn^VMo^frfi'^ 

d) ^Ife^^e-^/v^^ott^ti^VM^^^M'^ 

tticra, mi^xxfm2mm^miEm^^(Dmxi^m(Dm^±z^mm^h 
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^g|10(DS200— S218(»^S^3^«^bTff X.^J:V\ ^JZ/V 

iimtM<Dm^%mb%:WkiL\^xn ?m&ia^ ±mt.mco&iW-f&ft<7>miEfe, -y- 

[0261] *tc, ^yyv^/i^v— ^(7k^m)X(D±miLm^^&&te^xWiEi-z>£yiz. 

V ^-fii^— o*fc«— o^LT _hf*^g^^MEi-§ £5 ^LT^ £V \ 
[0262] *fc. ^l-03^ig?f^<^lll9(DSO24(D^f5A^:5u^MEi^^/V--^^M 

m&ik^ffijE±miLmmm<D%]Mmffi(pb2_ s , e b2_ s )^ mmmmmm 

# (Pb2_s, 0 b2_s) ^^^b^^/V#^(D_h#:{im^#^IW)— t-bTt \, fEL, 

mm^m, 2^mtcirm^L^miE±m±mmm^mmmx^mir^±x^ m 

[0263] ^l-^3«^B^^»7C^MEi^^-^-^(D^a-e^, tfrfB^ 

?<Dmm ^kwmmn^nMm^ (2) i^ot (mm^^mm^nm^x) 
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[0264] mi— M3mMftZM<DmiLik^m^%jEy--?sv— ^->(D%mx\ ^f/vm 
^M(pb2_ s , e b2_s)(D Mff mm) ^mmmmim^hmm^rtu wt^^m 

M(Pb2_s, 6b2_s)&m^^lE±m±Lm^9$bVXfemir%£yKVXh£\<\ & 

, •?T(D^^(D^M(Pb2_s ) 0b2_s)^^5cME_h#:M^tUT«:^i-§J;5^ 
[0265] t!)fE^2^ife?f^^Pb-C, ^l*5i:^2^fi^:^ttiEffl^^>KD^-e(0 

mn<D ^^t^^m^KMir^m2^^m^'f^(D±mM^A2, A3 
-r^mm^^^^wM-r fi\z.mtm\^\ tot, ^/^m^m^im 

if^±mn^A2, A3^#§{ig-ftL(P22-P21), (P32-P3l)(Dftt><9^ _hfB 

m$rt, ±mm^A2, A3^<^mmm^^t<D^mmr. ±mm&A2, a 

[0266] ^iCte, Z.<D*JUmMA2, A3(D^^-f^ra«^ ^jWf*2(»|lIiifj(Z>Eft 

tf^^mre#^fc«9^ -<D±mm&A2, A3<Dnm&m^ti&mmM<Dmfn 
)(Dmmft)& e tistibz. &±mn&A2, A3(Dmim^m-rtimmix, l* 
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sin(0 /2)\Z.m\-*^<Dht£Z> 0 &:J3, ft£U3, m±MV^24, 24^oV>TI^— X 

22-P21), (P32-P31)(Dft^»9^, »#:2«MfiP»fttf ^ 6 (CJSCtSm* 
sin( 0 / / 2)^ffiV^J;5i-b-C^j;V\ _h#:^^#^M^TOm^# 
#Pf*2(Dj|$|K^(^fttf^^n#Vhl^S^ ; e^>(y^^>) 

[0267] £fc, MSE^2^Jfe^^*5V N "C\ ^l*5j;^2^^5cMEffl^T : >KDM^ 

^mmmi^^M^w (2) i^ot (^^^#^^£-#-0 

^^V^Wt-^JSi-^ll2Mi^7cMiEffi^^>V(Z)#^:|ilK^A2, A3(D{ir.mt 

, ^i^i^^MiEffl^7 ; Vv(D^-^:JBi»^A2, A3<D{£g£<D[ig<z>ra-f ;ruo£C 

^r^mmcMir^^^miE±m±mmm(DmiEm^^x^^ttfi:^ 

„ ^rb-C, i(Z)#^^, #*MC,&A2, A3^5Ag(D-f ^t(D{-t^«9^, fiffBbfcMJ 

[0268] 
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[0269] sATumi-zt, s6oo^*5v>-c, m^^Mtcommit^ '/um^com£fiw.(m9 
[0270] #cvvc% s602^itA/-e, ^mw2(Dmmm<DmfM e frb, m^fcib^c^ 

[0271] ifc\^X\ S604^BA/-T:\ $Mffl\tt^A^&<D±{ttM$&^&V^&S602-V 

, m^k^vv^^-h^g^^, &mm, 2(Dmmm<Dmm^st^xy 
# ^ i ^xxim2mmjk^miEm ^/^m v m $ i , 2&mtc.-r 

[0273] ^^b\ ^4H»H-e«, _hf*^^<DME*^^i-§^* C»|V>f: 
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ffi^i-§^-^^o^iJ#:(y^)^M^^^MlEffi^VV(Z)^*i!LT^P 
[0275] ^!j^«n#Vhi^bKW*^#^t^v^Ji^^f$^i5^-^^{i, 

[0276] *7c. &^(Di£&(Dm& (^¥f^) © j;5 ^ mm^jvWiEm^/^(Dmm 
[0277] ^fc, «fr5, 5<DMmm<Dmw&ft yxttm&ia*. mm^mmnm^co^ 



[0274] 
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[0278] ^ mmm^mmMm-vnmvfcm^-tmmi^ ^-mw-^mmm^^t 

[0279] *fc, ^i-^4^W^t-PbTM^i-§^, '^o^i-^4^»B-e«, 

"Ctt, G1^G2^(D^(G1-G2) tt, f Mj^f /W^l'WitGs^n^VMoR 
<73^ft:m'il>figGf^(DM(Gs-Gf) , i-^^^^^k^-xVKD^^M'il^gcDig^ 
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[028i] ^k±Mm\^t'tw<. ^mrnn, m^^/^m^xi^^ntmmnm^m^ 
mm&, w^n^m^n^^^^mi^^mmcx^x, mm^m 

[0282] [Bll]«P^(D^W^^Mi-§#»n^Vh (2^^fn#Vb) 

[02]Hl(Dn7K5/h(D#p#:(D^^^*^^i-#Jffilllo 
[|2l3]Hl(Dn*^^h^#^$iJ^]^5,h(D«j^^-r^a5/^E| 0 

[07] (a) - (c) te\ ^i^W^^^(t^^iM»5cMlEffl^>v<i:m^b^ 

k 
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[sue (a) , (b) nmimmnm^m^x, ti^ y h(D^mm^m^h±i^r^ 

mi8M2mmnm\c^ir^mi^xxim2m^^iEm^^(D^m(Dmmm 
mmm2mmnm^mmi^xxfm2miL^miEm^^(Dmmmm^} 

m2im3mmnm\^^m2mm^k^iEm^^7jkirmo 
m22im3mm^m\^f^mi^xxim2mi^^iEm^^(D^m(7)mmn 

m23M3mmnm\^iir^m^^mmmiE^yyp-^>(D^m^ir^vi-- 
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m^mm 

iiiifBiji3<DBag£igioBa®£<DrHi^<D^ 

tifiBipB# i mmmmiE^^ mmmsmmtmimmt^mxfDmm^ 

1^F3(DMB;£lJ^«fBjg2<DBa®£Jgl^ 

m.mt)J$ft£ , 9h0lZ.}£^^ fi)fB^F3^tf f fBB(f^^*^«9^'ftffl-r^ 
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iiirfB#Kj£^Vh<^f*;i^ 

fUMj^ib, B»tb^*Vhopf^»^HiflB^>^^g^(Z)IBg^(DM#^m 
^i-SBff^02(D^#^^m^#t-^oT^^$tLSfif|B^^/V(D^-^m(O 

ffffBig2<Diag£ij|l<Die©£(DP^(Df^ 

M ttifBp0# g ^aibME^f*. tt)tB^2(DgaM^mi(Z)iEg^(Dr H i-e(Dti)fB^^ 
[5] tiifB^2(Diag^i(Dia®^(DrHi^#^^(^iBe^^}-#t>^tir?B^^^hj^ 

mjfB^VKDSi^o^-M^^^ tfifBlll(Z)iag^*Dtt5{i®A^tfrfB 
H2(DgHM^^it^igBO^^^BHi-5^^«, ffrfBJfT^£»fB^A^ 

tffiB]ff^^»?B{MB^^^^^^^i-^^^^ mnmz 
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mm^m^^xnm^ti^b^ub-r^m^mmm^m^yh^^mm 

flu 

[6] mmm2mmbmimmb(Dm(D^mmm(Dm\m^mm^—^hf^ 

ffi&m^rb, mtm^^bmmiiLmBb^^m^b^irnm^h. mnmz. 
m^mmmKmm^mm^mv^x%^ri^b^wmb'rmMm3tm<D^ 

[7] mmmmm^m^mm^ir^mm @ mtmrn^yh^mmbm 

^m^m^mmm^Kx^xm^ir^m^^m^oxh^b^xmm^ 
tc.m^i^v'/^m^^x^m^nxm, mm^M^ msmmmn^h<D{p 

mv^yh<Dmm$ij&mmo 

ry^(D^mm(Dmm<Dmmmmm^^xm±ir^mm(Dm^(D^Km 
&mzijjb, mmmmnmmm^h, mmm2<Dm^mm^m^^x^ 
^n^mm^/^^mmm^m^m^mm^x^xm^ir^co^-mmfDm 

u# @ mmm^x^xmmmti^^^xm^ir^RticDmmim—^cir^ 
Kmmmi^xxim2(Dmi^^M^m^&tix\^^b^mmb^mM 
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nmw-t^xm^-^^yvxm, mmmi^m^m^Mm*^ mm^/>± 

t^w^tir^mMmi^fc^tim^m^yb^m^^mUo 
mmm^(D-^mmn.mm^m^yb(D±i$imm(D^mi^t^mmm^ 
r^it^rpj mcmmxhz^t&wmtirzmMm 1 1 mm^m^y b(Dm^^m 

Mo 

^<Dm*i^<>xfcfe£n%mttT/i'<D&mm<DnmtiK mmm^nmmm^ 

m?Mmv^ybK&tf%mmmimfoir%m±Lmmim 

x\^t^mtir^mMmi^mmm(D^W}^yb(Dmm^mmo 
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(d * mutKm ft nr^wsfi «r*u mmmmmmm^^m^-r^mm @ m 
tb^jg^Mj^HLTfi^Kj^^ 

[15] itrfB^i(Dmf^«j^m^#«, # Rr»^^gpja#^Bf^^^, f«» 
m^nx^^t^wmtirmmmi4nm(D^m^yb(Dm^mmmo 

f»^^^§P(DTO»^m»^^^i5f^^^«^i3r, B-O, fi|fB_hftW 
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m^^mi^(D±i$ib(DmW^bm^m^(D^^b(Dm(D^mm>b\cm^ 

^^^fi^^^i^^tiffBMEM^^i-Sr^^m^i-^ff^^lTfB^cD^i!] 
[19] i#:d^®^$ttfc^<DP#:^c«m#:^^^m©^»fr^b-C«x.§^ 



WO 2005/068136 



86 



PCT/JP2005/000022 



[20] mm^mw-umw-xm , mmmm n mmmmiE^m^ mmm^t, striB# 
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